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Abstract —In this paper, we develop a distributed algorithm to 
localize an arbitrary number of agents moving in a bounded 
region of interest. We assume that the network contains at 
least one agent with known location (hereinafter referred to 
as an anchor), and each agent measures a noisy version of 
its motion and the distances to the nearby agents. We provide 
a geometric approach, which allows each agent to: (i) continually 
update the distances to the locations where it has exchanged 
information with the other nodes in the past; and (ii) measure 
the distance between a neighbor and any such locations. Based 
on this approach, we provide a linear update to find the locations 
of an arbitrary number of mobile agents when they follow some 
convexity in their deployment and motion. 

Since the agents are mobile, they may not be able to find 
nearby nodes (agents and/or anchors) to implement a distributed 
algorithm. To address this issue, we introduce the notion of a 
virtual convex hull with the help of the aforementioned geometric 
approach. In particular, each agent keeps track of a virtual 
convex hull of other nodes, which may not physically exist, and 
updates its location with respect to its neighbors in the virtual 
hull. We show that the corresponding localization algorithm, 
in the absence of noise, can be abstracted as a Linear Time- 
Varying (LTV) system, with non-deterministic system matrices, 
which asymptotically tracks the true locations of the agents. We 
provide simulations to verify the analytical results and evaluate 
the performance of the algorithm in the presence of noise on the 
motion as well as on the distance measurements. 


I. Introduction 

Localization is a well-studied problem, which refers to the 
collection of algorithms that estimate the location of nodes in a 
network. Relevant applications include traffic control, indus¬ 
trial automation, robotics, and environment monitoring [|TJ— 
(4j. In terms of the information used for estimating the 
locations, localization schemes in Wireless Sensor Networks 
(WSN) can be classified as range-based, 0-0’ and range- 
free, 0-EJ- While the former depends on measuring the 
distance and/or angle between the nodes, the latter makes 
no assumptions about the availability of such information 
and relies on the connectivity of the network. The literature 
on localization also consists of centralized and distributed 
approaches. Centralized algorithms, EJ-Ef despite their 
benefits, are impractical in large networks where each node has 
limited power and communication capability. Some notable 
distributed localization techniques include successive refine¬ 
ments, 10 |I8). multilateration, CDD-IDJ estimation based 
methods, multidimentional scaling (22) , and graph-theoretical 
methods, |23l|-(25jl. 


When ranging data is noisy, the following estimation-based 
localization techniques are widely used. Maximum Likelihood 
Estimation (MLE) methods estimate the most probable lo¬ 
cation of a mobile node based on prior statistical models. 
MLE only requires (current) measured data and does not 
integrate prior data. Sequential Bayesian Estimation (SBE) 
methods use the recursive Bayes rule to estimate the likelihood 
of an agent’s location. The solution to SBE is generally 
intractable and cannot be determined analytically. An alter¬ 
native approach is Kalman-based techniques, which are only 
optimal when the uncertainties are Gaussian and the system 
dynamics are linear, ]26|, |27|. However, localization has 


always been considered as a nonlinear problem and hence the 
optimality of Kalman-based solutions are not guaranteed. To 
address the nonlinear nature of localization problems, other 
suboptimal solutions to approximate the optimal Bayesian 
estimation include Extended Kalman Filter (EKF) and Particle 
Filters (PF), 1271. In particular. Sequential Monte Carlo (SMC) 
method is a PF that exploits posterior probability to determine 
the future location of an agent. 

Localization algorithms specifically designed for mobile 
networks have been proposed in Ref. (8|| introduces 

the Monte Carlo Localization (MCL) method, which exploits 
mobility to improve the accuracy of localization. Inspired 
by (8), the authors in © propose Mobile and Static sensor 
network Localization (MSL*) that extends MCL to the case 
where some or all nodes are static or mobile. Ref El proposes 
variations of MCL, namely dual and mixture MCL to increase 
the accuracy of the original MCL algorithm. On the other 
hand. Ref (5] provides Range-based Sequential Monte Carlo 
Localization method (Range-based SMCL), which combines 
range-free and range-based information to improve localiza¬ 
tion performance in mobile sensor networks. 

In this paper, we consider localization of a mobile net¬ 
work, assuming that each agent measures a noisy version 
of its distances to the nodes (agents and/or anchors) in its 
communication radiuf] and the motion it undertook, e.g., by 
using an accelerometer. We focus on scenarios where GPS (or 
related positioning system) is compromised and/or unavail¬ 
able, and develop a collaborative algorithm for a network of 
agents/robots to find their locations in order to implement a 
location-aware task or a mission. As an example, consider a 
network of mobile robots with no central or local coordinator 
and with limited communication, whose task is to transport 
goods in an indoor facility where GPS signals are not avail- 
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able. In order to perform a delivery task, each mobile robot 
has to know its own location first. In such settings, we are 
interested in developing an anchor-based distributed algorithm 
that uses only the distance and angle measurements to track 
the agent locations such that the convergence is invariant to 
the initial position estimates. However, the implementation and 
analysis of such distributed algorithm in mobile networks is 
not straightforward, because: (i) an agent may not be able to 
find nearby nodes at any given time to implement a distributed 
algorithm; (ii) an agent may not be in the proximity of an 
anchor at any given time; (iii) the neighborhood at each agent 
is dynamic, resulting into a time-varying distributed algorithm. 

In this context, the main contribution of this work is to 
develop a linear framework for localization that enables us to 
circumvent the challenges posed by the predominant nonlinear 
approaches to this problem. This linear framework is not 
to be interpreted as a linearization of an existing nonlinear 
algorithm. Instead, the nonlinearity from range to location 
is embedded in an alternate representation provided by the 
barycentric coordinates. However, forcing this linear update 
comes at a price, i.e., a location update is only possible when 
an agent lies in a triangle (convex hull in ]R 2 ) formed by three 
neighboring nodes. Since such neighbors may never exist, see 
(i) above, we introduce the notion of a virtual convex hull. 
We then show that localization in mobile networks can be 
achieved with exactly one anchor when the total number of 
nodes (agents and anchors) is at least 4 in R 2 . This is in 
stark contrast to the requirement of at least 3 anchors that 
is prevalent in the triangulation-based localization literature. 
See gOj for a recent survey on localization approaches with 
single vs. multiple anchor nodes. 

As we will discuss in Section [Vj we abstract the correspond¬ 
ing localization algorithm as a Linear Time-Varying (LTV) 
system whose system matrices may be: identity -when no 
location update occurs; stochastic -when there is no anchor 
among the neighbors of the updating agent; and, strictly 
sub-stochastic-when the neighborhood includes at least one 
anchor. Note that the order in which the updates occur and 
the weights assigned to the neighbors are not known a priori. 
To address these challenges, we apply a novel method to 
study LTV convergence by partitioning the entire chain of 
system matrices into slices and relating the convergence rate 
to the slice lengths. In particular, we show that the algorithm 
converges if the slice lengths do not grow faster than a certain 
exponential rate. Since our localization scheme is based on 
the motion and the distance measurements, it is meaningful 
to evaluate the performance of the algorithm when these 
parameters are corrupted by noise. Therefore, we study the 
impact of noise on the convergence of the algorithm and 
provide modifications to counter the undesirable effects of 
noise. Owing to the linear representation, we are able to 
provide a few simple yet comprehensive modifications to the 
proposed approach, which as shown in the simulations lead to 
a bounded error in the location estimates. 

We now describe the rest of the paper. In Section [IIJ we 
formulate the problem. We introduce the geometric approach 
to track the distances in Section III We then provide our lo¬ 
calization algorithm that relies on the notion of virtual convex 


hull in Section IV followed by the convergence analysis in 
Section [V] In Section [VlJ we examine the effects of noise on 
the algorithm. We provide simulation results and compare the 
performance of the algorithm with MCL, MSL*, Dual MCL, 
and Range-based SMCL algorithms in Section VII Finally, 
Section VIII| concludes the paper. 


II. Preliminaries and Problem formulation 

Consider a network of N mobile agents, in the set Cl, with 
unknown locations, and M anchor(s), in the set k, with fixed 
known locations, all located in IR 2 ; let 0 = PlUtc be the set of 
all nodes. Let x” £ I 2 be a row vector that denotes the true 
location of the z-th agent, * £ Cl, at time k , where k > 0 is 
the discrete-time index. Regardless of what motion modality 
(aerial, ground, kinematics) is employed by the agents, their 
motion can be expressed as the deviation between the current 
and next locations, i.e.. 


4+1 = 4*+4+l> *^0, d) 

where xj, is the true motion vector at time k. We assume that 
the agents move along straight lines, or otherwise the motion 
trajectories can be approximated by a piecewise linear model. 
This is a common assumption in robotics literature gT), e.g., 
a simple differential wheeled robot whose wheels run in the 
same direction and speed, will move in a straight line. We 
also assume that agent i measures a noisy version, xj,, of this 
motion, e.g., by using an accelerometer: 


where n' k is the accelerometer noise at time k. We assume 
that the motion is restricted in a bounded region in ]R 2 . We 
define the distance between any two nodes, i and j, measured 
at the time of communication, k, as <Tf . We assume that the 
distance measurement, d l k , at node i is not perfect and includes 
noise, i.e., 

4 = 4+ r fe> ( 3 ) 

in which r k is the noise in the distance measurement at time k. 
The problem is to find the locations of the mobile agents in 
the set Cl given any initialization of the underlying algorithm. 
We then consider the minimal number of anchors required for 
such a process to work. 

Main idea: We now describe the main idea behind our 
approach. In order to avoid nonlinearity in the solutioig] we 
consider a barycentric-based linear representation of positions; 
the advantage of a linear approach is that the convergence is 
independent of the initial location estimates. Let ®i(k) denote 
a set of three agents such that agent i lies inside their convex 
hull, C(®i(k)), at time k. In the barycentric-representation, the 
location of node i is described by a linear-convex combination 
of the nodes in 0.j(/c), i.e., 

4* = 44* + 44* + 44*. ©»(&) = {1,2,3} (4) 


2 When only distances to at least m +1 anchors are known in R m . trilatera- 
tion, e.g., in R 2 , requires 3 anchors and solves 3 circle equations, 132). Clearly, 
trilateration is nonlinear and coupled in the coordinates; while an iterative 
procedure built on these nonlinear updates does not converge in general. 
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in which x“ represents the true location of node i at time fc, 
and the coefficients, a k ’ s, are the barycentric coordinates , 
associated to Mobius, ( 33| , given by 

^0i(fc)U{i}\j 


a £ = 




(5) 


where ^4©^ (fe)u{i>\j denotes the area of the convex hull formed 
by the agents in the subscript set. To implement this update, 
agent i has to lie inside the convex hull of the (three) 
neighbors in the set 0j(fc). Appendix [F] provides a simple 
procedure, 0. to test if an agent lies inside or outside of the 
convex hull formed by the nearby nodes. Finally, note that the 
barycentric coordinates are always positive and they sum to 1. 

Challenges and our approach: To implement the above 
barycentric-based procedure, agent i must acquire the mutual 
distances among the 4 nodes (in the set {iU0j(fe)}). However, 
an agent may never find such a convex hull because the nodes 
are mobile, in a region possibly full of obstacles, with limited 
communication and/or visual radius. To address this challenge, 
we provide a geometric approach that allows an agent to 
track its distance to any location, where it has exchanged 
information with the other nodes in the past (Section |III-A) . 
We further show that at the time of communication an agent 
can compute the distance between a neighbor and any such 
locations (Section I1I-B| >. Using these methods, we introduce 
the notion of a virtual convex hull, which is a triangle whose 
vertices are located at the virtual locations where the agent 
exchanged information in the past (Section [TV]). The described 
approach results in a rather opportunistic algorithm where an 
update occurs only when a certain set of real and virtual 
conditions are satisfied. The subsequent analysis is to charac¬ 
terize the convergence of such LTV algorithms whose system 
matrices are non-deterministic. In this paper, we rigorously 
develop the conditions of convergence and study the location¬ 
tracking performance of this procedure (Section [vj. 

We now enlist our assumptions: 

AO: Each anchor, i £ k, knows its location, x“ = Xq*, Vfc. 
Al: Each agent, i £ fl, has a noisy measurement, xj., of its 
motion vector, xj., see Eq. ©• 

A2: Each agent, i £ fl, has a noisy measurement, d l k , of 
the distances to nodes, j £ 0 within a radius, r, see Eq. CD- 
Under the above assumptions, we are interested in finding 
the true locations of each agent in the set O, without the 
presence of any central coordinator. In the process, we study 
what is the minimal number of anchors required and in 
particular: does mobility reduce the number of anchor^] from 3 
in R 2 (Section [vj. In the following, we first discuss the ideal 
scenario when the motion and distance measurements are not 
affected by noise. We then evaluate the performance of the 
algorithm in the presence of noise on the motion as well as on 
the distance measurements, and present a modified algorithm 
to counter the undesirable effects of noise (Section [VT|). 

III. A Geometric Approach towards Localization 
In this section, we consider the motion and distance in the 
noiseless case, i.e., n k = 0 and r l k = 0, in Eqs. Q and <|3). Let 


the true location of the v'-th agent, % £ O in ]R 2 , be decomposed 
as x” = [x l k y™]. We then describe the motion of agent i as: 


x 


i* 

fc+1 


2/fc+i 


4* + djUk+i cos 
y l C + djUfc+t sin 


{ ^2 ®k'->k' +1 + 0 l o) ! 
\fc'=l / 

(j2 e i'^'+i +d ° j > ( 6 ) 


where d k ^. k+1 and 9 k ^. k+ 1 d en °te the distance and angle 
traveled by agent i, between time k and k + 1, and 6 g is 
agent i’s initial orientatiorf] see Fig. [l] Let us also consider 



Fig. 1. Initial orientations of TV = 4 agents; filled colored circles and red 
triangle indicate the initial locations of the agents, i, j, l, n and the anchor, A, 
respectively; red circle shows the communication radius of agent i. 

a vision-based distance measurement process, where an agent 
needs to see another agent with its camera in order to find 
the mutual distance, as opposed to wireless-based distance 
measurements that are prone to extremely large errors. When 
agent i moves to a new location at time k, it first scans the 
neighborhood, i.e., rotates by an angle, 0 < ft k < 2tt, in 
order to find (and make visual contact with) another node 
(agent or anchor). If the agent does not find any neighbor 
at time k, then f3 k = 0. If on the other hand, agent i finds 
another node within the communication radius, it exchanges 
information with that node, then makes another rotation by 
an angle, 0 < a k < 2n, which is randomly chosen at 
each iteration, and travels the distance of d\^ k+1 in the new 
direction. Thus, the angle traveled by agent i between time k 
and fc + 1, 4_»fc+ 1 > can be represented as 

4->fc+1 = a k + Pk k — 0- (?) 

Before we proceed, note that under perfect motion and noise¬ 
less distance measurements, an agent cannot find its position 
by direct communication with an anchor, unless it knows its 
angle towards the anchor with respect to a mutual frame; in 
contrast, the proposed framework in this paper assumes that 
only relative angles are known to each agent. For example, 
agent i in Fig. |T] initially finds anchor A in its communication 
radius. However, in order to find its exact location, agent i 
needs to know 0 ' {) , in addition to Xy* and d l 0 A . We assume 
that such angles are not available to the agents. 

In what follows, we first explain the procedure to track 
the distance between an agent and the locations where it 
has exchanged information with other nodes in the past. We 


'The minimal number of anchors required to solve a localization problem, 
without ambiguity, given only distance measurements is m in K m , |32|. 


4 Note that these initial orientations, 0q’s, are arbitrary and we neither 
assume any global synchronization nor we know what the true angles are. 
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then show how an agent can compute the distance between a 
neighbor and any such location at the time of communication. 


A. Tracking the distance after a direct communication 

Consider an agent, i £ Cl, to fall within a distance, r, of 
node, j £ 0, at some time kj ; by Assumption A2, agent i 
can measure its distance, df to node j , and receive j-th 
node’s location estimate, hereinafter denoted as x{ . Once this 

Kj 

information is acquired at time kj, agent i tracks the distance 
to the true position, x 3 k , for all k > kj, even when the two 
agents move apart. In other words, agent i, has the following 
information for each node it has communicated with: 

{j, kj , djf, x 3 ,, }, k > kj , j £ 0, (8) 

where kj is the instant of the most-recent contact, and (If is 
the distance between the true positions, x” and X'T, fc > kj. 
This procedure is illustrated in Fig. [2] Note that in order to 



B. Finding the distance with indirect communication 

We now show how agent i can use the distance/angle 
information to find the distances between a neighbor and any 
virtual location, where it has previously communicated with 
another node. 

Lemma 2. Suppose agent i has previously made contact with 
node, j, hence possesses the following information: 

{j,kj,df ,x 3 kj }, k > kj, 

Suppose agent i finds a neighbor, say agent i, at time ki > kj. 
Agent i can then find the distance between x k * and x k * as 
follows: 

( d £) 2 + (<) 2 - 2 <- f < cosZ K J ,.<). (! 0 ) 

in which df ( is the distance between x’f and xjf, 
and Z(df e ,df t ) is the angle between the two lines connect¬ 
ing x fc* f to and x £*- 



Fig. 3. At time kg, agent i finds the distance between a new neighbor, node l, 

and the virtual location, , where it exchanged information with node j at 

K j 

time kj < kn. 


Fig. 2. Distance tracking after a direct communication; agent i is indicated 
by red filled circle; agents j and / are represented by blue and green circles, 
respectively; red circle indicates the communication radius. 


make contact with agent j, agent i has changed its orientation 
by f' k at time kj, see Fig.|2j(a). After the two agents exchange 
information, agent i changes its orientation by a‘ k , Fig. |(b), 
and travels the distance of d\ _^ k +1 in the new direction, 
Fig.0 (c). We now show how an agent tracks the distance to 
a virtual location, where it has exchanged information with 
another node in the past. 


Lemma 1. Consider agent, i £ Cl, with true position, x l f_. 
Suppose agent i communicates with node, j £ 0, at time kj. 
Let (If be the distance between i and j at the time of 
communication. Suppose agent i and j move apart at time kj- 1- 
1, where the motion is given by d k ^ k . +1 and 9 k ^ k+1 , 
both ktiown to agent i. The distance between the true posi¬ 
tions, xjj,* +1 and x k *, is 


d lJ = 

U k j +l 


(Kj) 2 + 1 ) 2 - 2 df.d l k .^ kj+1 cos(o^)) 2 . (9) 

See Appendix [B] for the proof. Note that at time k 3 + 1, 
agent i finds agent l in its communication radius, hence 
changes its direction by fi l k . +1 in order to make contact with 
agent l, see Fig [2] (d). 


See Appendix [C] for the proof. 

In the next section, we use these distance tracking methods 
to describe the position tracking algorithm. 

IV. Distributed Mobile Localization: Algorithm 

Consider a network of N agents with unknown locations 
and M anchors, according to the motion model introduced in 
Section [II] Let Vf k) C 0 be the i-visited set, defined as the 
set of distinct nodes visited by agent, i £ Cl, up to time fc; 
and call an element in this set as i-visited node. We start by 
introducing the notion of a virtual convex hull. 


A. Virtual convex hull 


Suppose agent i communicates with node j at time kj, and 
obtains the distance, df to j, along with j’s current location 
estimate, x k , i.e., j £ Vi(kj). At any time, k > kj, agents, i 


and j, may move apart but agent i now knows df Vk > kj. 


using the geometric framework discussed in Section III-A 
At some later time, ke > kj, agent i makes contact with 
another node, £, and thus obtains xfi and d l k , and keeps 


track of d k , Vfc > 


thus j, £ £ Vi(k),\/k > he. Using 
the approach described in Section III-B| at time k(, agent i 
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also computes , i.e., the distance between xj.* and x£*. 
Finally, agent i meets agent n at some k n > kg, and thus now 
possesses the location estimates: x'[ , x kf , x£ ; and the dis¬ 
tances: d l k , k > k n , with q = j. £, n (computed by Lemma |Tj», 
along with the following distances: djf , d k \ and d r k (com¬ 
puted by Lemma 0. At this point j,£,n £ Vi(k),Vk > k n , and 
agent i can use the 6 distances to perform the inclusion test, 
described in Appendix [F] to check if the three visited nodes 
forms a virtual convex hull in which agent i lies at time k. If 
the test is passed, the set, 0i(fc) = {j,£,n} C Vj(fc), forms 
the virtual convex hull; otherwise, agent i continues to move 
and add nodes in V, {k) until some combination passes the 
convexity test. Note that the distance between the agent and 
each of the virtual locations is updated every time agent i 
moves to a new location. However, the distance between the 
virtual locations does not change unless agent i revisits any 
of the previously visited nodes. 

Fig. |4] (a) shows the trajectories of four agents: O, □, 0,0, 
over k = 1,..., 9; the time-indices are marked inside the 
agent symbols. From the perspective of agent O, see Fig. [4] 
(b): it first makes contact (communicates) with agent □, at 
time k\j = 2, and then they both move apart; next, it makes 
contact with agents, O at kQ = 4, and O at ktj = 6. 
We have V 0 (2) = {□}, V 0 (4) = {d,0}, and V 0 (6) = 
{□, 0,0}, where a non-trivial convex hull becomes available 
at k = 6. However, agent O does not lie in the corresponding 
convex hull, C(Vq(6)), and cannot update its location estimate 
with the past neighboring estimates: , xj^, x^. At this 

point, agent O must wait until it either moves inside the 
convex hull of □, 0,0, or finds another agent with which the 
convexity condition is satisfied. Fig0illustrates this process in 
four frames. The former is shown in Fig. [4] (d), where agent O 
has moved inside C(Vq(6)) at some later time, k = 9; we 
have 0 O (9) = {d,0,o}. The notion of a virtual convex 
hull is evident from this discussion: an agent may only 
communicate with at most one agent at any given time; when 
the convexity condition is satisfied eventually, the updating 
agent may not be in communication with the corresponding 
nodes. Once 0 o (fc) is successfully formed, agent O updates 
its location linearly using the barycentric representation in 
Eq. 0, where the coefficients are computed using the distance 
equations in Lemmas [T] [2] and the Cayley-Menger determinant 
to compute areas. After this update, agent O removes 0 o (fc) 
from Vj(O), as the location estimates of the nodes in 0 O (k) 
have been consumctQ 

The following result will be useful in the sequel. 

Lemma 3. For each i £ Q, there exists a set, Qi(k ) C Vi(k), 
such that |0j(fc)| = 3 and i £ C(@i(k)), for infinitely 
many k’s. 

See Appendix [D] for the proof. 


5 We choose this simple strategy to remove information from V, (k) for 
convenience. Another candidate strategy is to use a forgetting factor, which 
chooses the past used nodes less frequently. 


B. Algorithm 

We now describe the localization algorithnf] in this case 
according to the number, |Vi(fc)|, of i-visited nodes in the i- 
visited set, V, (k). There are two different update scenarios for 
any arbitrary agent, i: 

(i) 0 < V,;(fc)| < 3: Agent, i, does not update its current 
location estimate. 

(ii) |Vj(A;)| > 3 : Agent, i, performs the inclusion test; if the 
test is passed the location update is applied. 

Using the above, consider the following update: 

x fe+t = afe x l- + (! - otk ) E a k x fc + *M-i> (11) 

jeeAk) 


where x l k is the vector of the f-th agent’s coordinates at 
time k, x’ fc , 1 is the motion vector, a k is the barycentric 
coordinate of node i with respect to the nodes j £ (-),(/;;), 
and ak is such that 


r i, vk i G f (k) = 0, 

\ G Vk I 0fik)yk0 


where /3 is a design parameter and O fik) is a virtual convex 
hull. As we explain later, an updating agent receives the 
valuable location information only if it updates with respect to 
an anchor, or another agent that has previously communicated 
with an anchor. The non-zero self-weights assigned to the 
previous state of the updating agent guarantees that the agent 
does not completely forget the valuable information after 
receiving them, e.g., by performing an update where none 
of the agents in the triangulation set has previously received 
anchor information. Note that 0i(k) = 0 does not necessarily 
imply that agent i has no neighbors at time k, but only that 
no set of neighbors meet the (virtual) convexity. The above 
algorithm can be written in matrix form as 


x k+1 = P fc x fc + B k u k + x fc+1 , k > 0, (13) 


where x k is the vector of agent coordinates evaluated at 
time k, U/, : is the vector of anchor coordinates at time k, 
and Xfc + i is the change in the location of agents at the 
beginning of the k —th iteration according to the motion model. 
Also P/,. and B/, are the system matrix and the input matrix 
of the above LTV system. We denote the (i, j)-th element of 
the matrices, P k and B^., as (P k )ij an d (B^), j, respectively. 
We can now rewrite Eq. © as 

X fe+1 = a k x l k + {l-a k )[ a k Xfc] , 

+ (i -<**)( E 4 ro <)+xUi, (14) 

ymG0i(fc)n«; J 

where u™ denotes the known coordinates of the m-th anchor 
at time k. Thus, (P k )i,i = ot k as defined in Eq. ( [T2| ), and 

(P k)i,j = (1 - ot k )dj! if j £ @i(k ) n fl, 

(Bfc)», m = (1 - ctfcjaJT if me 0;(fc) (T k, (15) 


6 Main steps of the algorithm are summarized in 


Appendix |e] 
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Fig. 4. Virtual convex hull with four agents: O, □, 0,0; with respect to agent O' (a) Agent trajectories and time-indices; (b) O ++ □ at = 4, O O 
at kQ = 4, O ++ O at ko = 6; circles indicate communication radius of agent O; (c) Virtual convex hull of agents, □, 0,0, available at agent O at k = 6; 
(d) Trajectories at k > 6, test passed at k = 9. 


If the triangulation set for agent i at time k does not contain 
the j-th agent or the m-th anchor, the corresponding elements 
in system and input matrices, (P f)i,j and (B k)i,m are zero. 
Note that Eq. ( [T2| ) immediately implies that the self-weight at 
each agent is always lower bounded, i.e., 

O<0<(P fc )i,i<l»VM- (16) 

Since accurate information is only injected via the anchors, 
it is reasonable (and necessary) to set a lower bound on the 
weights assigned to the anchor states. In particular, we make 
the following assumption. 

A3: Anchor contribution. For any update that involves an 
anchor, i.e., for any (Bfc)i jm ^ 0, we assume that 

o < a < (Bk)i,m, Vfc,*en,me0,(fc)nK, (17) 

where a is the minimum anchor contribution, see Section [Y^B] 
Assumption A3 implies that if there is an anchor in the 
(virtual) convex hull, it always contributes a certain amount 
of information. In other words, the updating agent has to lie 
in an appropriate position inside the convex hull. Assumption 
A3 states that the weight assigned to the anchor (which comes 
from barycentric coordinates) should be at least a. Therefore, 
the area (in R 2 ) of the triangle corresponding to the anchor 
must take an adequate portion of the area of the whole 
convex hull triangle. This is illustrated in Fig. [5] where the 
updating agent lies inside a virtual convex hull, consisting of 
an anchor (node j), and two other agents, m and L Node i 
has communicated with the anchor and the two other agents, 
at time instants, kj, k m , and ke, respectively. 



Fig. 5. (Left) At time k, agent i is located on the threshold boundaries, which 
assigns the minimum weight, a, to the anchor. (Right) At time k' agent i is 
located in an inappropriate location inside the convex hull. 


Fig. 0 (Feft) illustrates the position of agent i at time /;:, xj, 
on the threshold boundaries, such that 


(B 


k)i,j 


A ei(k)u{i}\j 




= a. 


0;(fc) 


08 ) 


Fig. 0 (Right) on the other hand shows that if the agent lies 
in xj.* (or any other position within the triangle of xj", x[j, 
and x™*), the left hand side of Eq. ( p~8| > becomes less than a, 
and Eq. ( fT7) > does not hold. Since the corresponding update 
does not provide enough valuable information for agent i, no 
update occurs in this case. 

With the lower bounds on both the self-weights, Eq. 
and the anchor weights, Eq. ( fTT| , we note that at time k, the 
matrix of barycentric coordinates with respect to agents with 
unknown locations, i.e., the system matrix P/,, is either 

(i) identity , when no update occurs; or, 

(ii) identity except a stochastic i-th row , when there is no 
anchor in the virtual convex hull, i.e., &i(k) C\k = 0; or, 

(iii) identity except a strictly sub-stochastic i-th row, when 
there is at least one anchor in the virtual convex hulQ 


In the next section, we provide sufficient conditions under 
which the iterative localization algorithm, Eq. ( p~3] >, tracks 
the true agent locations. Before we proceed, let us make the 
following definitions to clarify what we mean by (strictly sub-) 
stochasticity throughout this paper: 


Definition 1. A non-negative, stochastic matrix is such that all 
of its row sums are one. A non-negative, strictly sub-stochastic 
matrix is such that it has at least one row that sums to strictly 
less than one and every other row sums to at most one. 


V. Distributed Mobile Localization: Analysis 

In this section, we address the challenge on the analysis 
of LTV systems with potentially non-deterministic system 
matrices. We borrow the following result on the asymptotic 
stability of LTV systems from |35| . 


A. Asymptotic stability of LTV systems 

Consider an LTV system: x^ + i = P^x^ such that the 
system matrix, P/ :: , is time-varying and non-deterministic. The 

7 Note that if an agent lies inside a virtual convex hull of three anchors, 
then practically by assigning a zero weight on its past, the agent can find 
its exact location and take the role of an anchor, which could subsequently 
increase the convergence rate of the algorithm. 
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system matrix, P^, represents at most one state update, say 
the i-th state, for any k, i.e., at most one row, i, of P/, is 
different from identity and can be either stochastic or strictly 
sub-stochastic, not necessarily in any order and with arbitrary 
elements as long as the bounds in (A3), (BO), and (Bl) in the 
following are satisfied: 

BO: If the updating row, i, in P*. sums to 1, then 

0 < pi < (P k)i,u Pi £ M, (19) 

Bl: If the updating row, i, in P/,. does not sum to 1, then 

E( p <02<l, fte R. (20) 

3 

To analyze the asymptotic behavior of an LTV system with 
such system matrices, we utilize the notion of a slice, M , 
which is the smallest product of consecutive system matri¬ 
ces, such that the entire chain of systems matrices is cov¬ 
ered by non-overlapping slices, i.e., IL M t = IlfcPfc, and 
each slice has a subunit infinity norm (maximum row sum), 
i.e., HMflloo < 1 ,Vi. 



Fig. 6. Slice representation. 

Slices are initiated by strictly sub-stochastic system matri¬ 
ces, and terminated after all row sums are strictly less than 
one. Slice representation is depicted in Fig. [ 6 ] where the 
rightmost system matrices (encircled in Fig. [ 6 ]) of each slice, 
i.e., Pg, P mo , ..., P m _!•••, are strictly sub-stochastic. 
The length of a slice is defined as the number of matrices 
forming the slice, and for the j-th slice length we have 
Mj = rrij — TOj_i,to_i = 0. Ref. [351 also shows that the 
upper bound on the infinity norm of a slice is further related 
to the length of the slice, i.e., the number of matrices forming 
the slice. The following theorem characterizes the asymptotic 
stability of the above LTV system. 


stability of the system is guaranteed if all (or and infinite subset 
of) slices have bounded lengths. Theorem [I] states that the 
system is asymptotically stable even in the non-trivial case, 
where there exist an infinite subset of slices whose lengths 
are not bounded, but do not grow faster than the exponential 
growth in Eq. As detailed in {35) , if the lengths of an 
infinite subset of slices follow Eq. {21} , the infinite product of 
slices goes to a zero matrix, and the system is asymptotically 
stable. Note that in the RHS of Eq. {TT) , the first In is negative; 
for the bound to remain meaningful, the second In must also 
be negative that requires fa < e^ -72 * 71 \ which holds for 
any value of fa £ [ 0 , 1 ) by choosing an appropriate 72 > 0 . 
Please see [35 ] for a detailed discussion on Eq. © and its 
parameters. With the help of this theorem, we now analyze 
the convergence of Eq. (fl3| in the following section. 


B. Convergence Analysis 

We now adapt the above LTV results to the distributed 
localization setup described in Section [Tl] Recall that the i- 
th row of the system matrix, P/, in Section V-A| collects 
the agent-to-agent barycentric coordinates corresponding to 
agent i and its neighbors. We now relate the slice representa¬ 
tion in Theorem[[] to the information flow in the network: Each 
slice, Mj, is initiated with a strictly sub-stochastic update, 
i.e., when one agent with unknown location directly receives 
information from an anchor by having this anchor in its virtual 
convex hull. On the other hand, a slice, M ;j , is terminated after 
the information from the anchor(s) is propagated through the 
network and reaches every agent either directly or indirectly. 
Here, directly means that an agent has an anchor in its virtual 
convex hull; while indirectly means that an agent has a neigh¬ 
bor in its virtual convex hull, which has previously received the 
information (either directly or indirectly) from an anchor. Once 
the anchor information reaches every agent in the network, 
the slice notion and Theorem |T| provide the conditions on the 
rate, Eq. at which this information should propagate for 
convergence. We proceed with the following lemma. 


Lemma 4 . Under the conditions A0-A3 and no noise, the 
product of system matrices, P j~’s, in the LTV system, Eq. 
converges to zero if the condition in Theorem^holds. 

Proof First, we need to show that the Assumptions B0-B1 
follow from AO-A3. First, note that BO is immediately verified 
by Eq. ( fT6) , assuming p\ = ft. Next, we note that Bl is 
implied by A3. This is because if IT k is not empty, we can 
write 


Theorem 1. With Assumptions, B0-B1, the system, = 

PfcXfc, converges to zero, i.e., lim^^ x*. = O^r, if for 
every i £ N, there exists a subset, J, of slices such that 

1 (l - e ( _72i_ ' 1 ' 1 )\ 

i-A j +1 ' (21 > 

for some 71 £ [0,1], 72 > 0. For any other slice, j J we 
have |Mj| < 00 . 

The proof is available in our prior work, {35}. Here, we 
explain the intuition behind the above theorem. The asymptotic 


E ( p *E = 1 - E ( 22 ) 

j€®i(k) nf2 mG0i(fc)n/t 

where we used the fact that the barycentric coordinates sum to 
one. When there is only one anchor among the nodes forming 
the virtual convex hull, and the minimum weight is assigned 
to this anchor, Eq. <tn>- the right hand side of Eq. {22} is 
maximized. This provides an upper bound on the z-th row 
sum: 

E ( p fc)ij <!-«<!. ( 23 ) 

j£Oi(k)nn 














which ensures B1 with If = 1 — o. In addition. Lemma [3] 
ensures that each agent updates infinitely often with different 
neighbors. Subsequently, each slice is completed after all 
agents receive anchor information (at least once) either directly 
or indirectly, and the asymptotic convergence of Eq. m 
follows under the conditions in Theorem Q] O 

Note that Assumption BO, which is equivalent to Eq. m 
implies that each agent remembers its past information. If a 
lower bound on the self-weights is not assigned, an agent may 
lose valuable information when it updates with other agents 
that have not previously updated (directly or indirectly) with 
an anchor. On the other hand, Assumption B1 restricts the 
amount of unreliable information added in the network by the 
agents, when an anchor is involved in an update. 

The following theorem completes the localization algorithm 
for mobile multi-agent networks. 

Theorem 2. Under the Assumptions A0-A3 and no noise, for 
any (random or deterministic) motion that satisfies Eq. m 
Eq. d asymptotically tracks the exact agent locations. 

Proof. In order to show the convergence to the true locations, 
we show that the error between the location estimate, x/ ;: , and 
the true location, x£, goes to zero. To find the error dynamics, 
note that the true agent locations follow: 


Theorem 3. Under Assumptions AO-A3 and no noise, Eq. ( |13| ) 
tracks the true agent locations in R 2 , when the number of 
agents, N, and the number of anchors, M, follow: 

M > 1, (27) 

N + M > 4. (28) 

Proof. Let us first consider the requirement of at least one 
anchor. Without an anchor, a strictly sub-stochastic row never 
appears in P/,., making stochastic at each time and 

hence the infinite product of P/.’s is also stochastic and not 
zero. With at least one anchor, strictly sub-stochastic rows, 
following Eq. ( [23) , appear in P/7s, and zero convergence of 
the error dynamics, Eq. ( |25) , follows. Next, exactly 3 nodes 
(agents and/or anchors) are required to form a (virtual) convex 
hull in R 2 . Thus, when the total number of nodes, N + M , 
is 3 or less, no agent can find 3 other nodes to find (virtual) 
convex hulls. Using the same argument as the one in the proof 
of Lemma [3] we can show that with at least one anchor and at 
least 4 total nodes, any agent with unknown location infinitely 
finds itself in arbitrary (virtual) convex hulls. Thus, Theorem)!] 
is applicable and the proof follows. □ 

VI. Mobile localization under imperfect 

MEASUREMENTS 


Xfc +1 = PfcXfc + BfeUfc + x fc+ i. (24) 

Subtracting Eq. m from Eq. we get the network error 

®fc+l — X fc+1 Xfc_|_i Pfc(x^. X/j) — P k^k: (25) 

which goes to zero when 

k 

lim TTPf = Ojvxiv, (26) 

k—foo A 
1=0 

from Lemma EO O- 


Before we proceed, it is reasonable to comment on the 
choice of parameter a; The proposed localization algorithm 
is proved, both in theory and simulations, to converge for any 
value of 0 < a < 1. However, the convergence rate of the 
algorithm is affected by the choice of a as follows. Choosing a 
arbitrarily close to zero corresponds to an infinitely large 
upper-bound on the length of a slice (this can be verified 
by replacing a = 1 — fa by zero on the right hand side of 
Eq. ( [21) . On the other hand, by setting a arbitrarily close 
to one, an agent has to get arbitrarily close to an anchor 
in order to perform an update with respect to the anchor 
(see Fig. [5), which again leads to arbitrary large number of 
iterations required for each slice to complete. In summary, 
there is a trade-off in the choice of a, between receiving 
more information from an anchor at the time of an update, 
which is the case for a values closer to 0, and increasing the 
chance of an update with an anchor, which requires for a to be 
closer to 1. A proper choice can be made by considering the 
motion model, the communication protocol, and the number 
of available anchors in the network. 

The following theorem characterizes the number of anchors. 


The noise on distance measurements and motion degrades 
the performance of the localization algorithm, as expected, and 
in certain cases the location error is as large as the region of 
motion; this is shown experimentally in Section VII-B In what 
follows, we discuss the modifications, M1-M3, to the proposed 
algorithm to address the noise in case of motion, x'J., and on 
the distance measurements, . 


A. Agent contribution 

If an agent is located close to the boundaries of a (virtual) 
convex hull, noise on distance measurements may lead to 
incorrect inclusion test. Appendix [F| results, i.e., a set of 
visited neighbors may fail the convexity test while the agent is 
indeed located inside the convex hull, or vice versa. To avoid 
such scenarios, we generalize Assumption A3 to non-anchor 
agents. In particular, we restrict an agent from performing 
an update, unless it is located in a proper position inside a 
candidate (virtual) convex hull. We augment Assumption A3 
by the following: 

Ml: For any agent, j € Cl, involved in an update, i.e., for 
any (Pfc)ij f 1 0, we assume that 

o < a' < (Pfc)^, VM 0 i(fc) n n, (29) 

where i is the updating agent’s index, and a' is the minimum 
agent contribution. In other words, for agent i to perform an 
update, the area of the corresponding inner triangle has to 
constitute a minimum proportion, a', of the area of the convex 
hull triangle. This is shown in Fig.[7](Left); At time k\, agent i 
is located in the virtual convex hull of the nodes j, m and l, 
such that the ratio of the area of the shaded triangle to the 
area of the convex hull triangle is a'. Agent i can perform an 
update at time k-\. The upper side of the shaded trapezoid in 
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Fig. 7. (Left) Agent i is located on the threshold boundaries, which assigns 
the minimum weight, a, to the anchor. (Right) Agent i is located in an 
inappropriate location inside the convex hull. 


Fig. □ (Right) is the threshold boundary. If agent i remains 
in the same virtual convex hull, but moves inside the shaded 
trapezoid, e.g., to x|* at time k->, Eq. ( [29] ) will not hold and 
no update will occur at that time. Clearly, Assumption Ml can 
be relaxed if the noise is negligible. Otherwise, the value of a' 
can be adjusted according to the amount of noise on distance 
measurements. 


B. Inclusion test error 

Even if Assumption Ml is satisfied, the inclusion test 
results may not be accurate due to the noise on the motion, 
which corresponds to imperfect location updates at each and 
every iteration. To tackle this issue, we propose the following 
modification to the algorithm: 

M2: If the inclusion test is passed at time k by a triangu¬ 
lation set, @i(fc), agent i performs an update only if 

e , = ^ (J0) 
A &i{k) 

in which e' k > 0 is the inclusion test relative error for agent 
i at time k, and e > 0 is a design parameter. 


C. Convexity 

Finally, recall that if the inclusion test is passed at time k, 
by a triangulation set, ®i(k), the updating agent, i, updates its 
location estimate, x”, as a convex combination of the location 
estimates of the nodes in In order to guarantee the 

convexity in the updates in presence of noise, we consider the 
following modification to the algorithm: 

M3: If the inclusion test is passed at time k by a trian¬ 
gulation set, 0i(fc), and Eq. ( |30| > holds at time k, agent i 
(randomly) chooses one of the /'-visited nodes from the trian¬ 
gulation set ®i(k), say agent j, and finds the corresponding 
weight, a ?, as follows: assuming that a*™ + a™ < 1, 

a%=l-a k n -a™, {j,m,n} e ®i(k). (31) 


VII. Simulations 

In this section, we first provide simulation in noiseless 
scenarios and then examine the effects of noise. 


A. Localization without noise 


We now consider the noiseless scenarios, i.e., we assume 
that n\ = 0 and r k = 0, in Eqs. ([2| and (|3). In the 
beginning, all nodes (agents and anchor(s)) are randomly 
deployed within the region of £ £ [—5 15], y € [—5 15] in R 2 . 
For the simulations, we consider random waypoint mobility 
model, |36) , for the motion in the network, which has been 
the predominant motion model in the localization literature 
over the past decade, see e.g., 0-jTo), (37). We note that 
better performance may be achieved if the agents follow some 
deterministic (mission-related) motion model. However, our 
localization algorithm converges if the motion is such that the 
slice lengths grow slower than the exponential rate in Eq. ©■ 
For all mobile nodes, i £ 0, we chose d l k _ ¥k+1 and 9 l k ^ k+1 
in Eq. (6]) as random variables with uniform distributions over 
the intervals of [0 5] and [0 27t], respectively. Each agent can 
only communicate with the nodes within its communication 
radius, which is set to r = 2 for all simulations. For each 
simulation, we assume exactly one fixed anchor, i.e., M = 1. 
In all simulations, we set ctk = 0.2 to ensure that the agents 
do not completely forget the past information and a = 0.1 to 
guarantee an adequate contribution from the anchor(s). 

Fig. 0 (Left) shows the random trajectories of N = 3 
mobile agents and M = 1 anchor for the first 25 iterations. 
To characterize the convergence, we choose the 2-norm of the 
error vector normalized with respect to the dimensions of the 
region as follows: 



in which Ax = 20 and Ay = 20 denote the lengths of the 
region, which is a square in this case. The division by Ax 
and Ay is done to obtain a normalized error. It can be verified 
that the maximum error with this normalization is -4=. The 

V 2 ___ 

algorithm converges when ||e^||2 —> 0. As shown in Fig. nd 
(Right), the localization algorithm, Eq. m tracks the true 
agent locations. The simulation results for a network of 10 


3 agents, 1 anchor 




Fig. 8. A network of 3 mobile agents and 1 anchor; (Left) Motion model; 
(Right) Convergence; red triangle indicates anchor and filled circles show the 
initial positions of the agents. 


and 100 mobile agents and one mobile anchor is illustrated in 
Fig. [9] (Left) and (Right), respectively. 

Before we examine the effects of noise on the proposed 
localization algorithm, let us study the case where there is no 
anchor in the network, i.e., Eq (|27[ is not satisfied; In most 
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Fig. 9. Convergence of a network with one anchor; (Left) 10 mobile agents 
(Right) 100 mobile agents. 


normalized localization error is reduced to less than 5% for 
one simulation. 




localization algorithms, m +1 anchors are required to localize 
an agent with unknown location in R m without ambiguity. 
However, when the nodes are mobile, exactly one anchor is 
sufficient to inject valuable information and the motion of the 
agents provides the remaining degrees of freedom. When there 
is no anchor in the network, all updates are stochastic, and we 
get efc + i = Pfcefc, with p(Pk) = l,Vfc, where p{.) denotes 
the spectral radius, i.e., a neutrally stable system, which leads 
to a bounded steady-state error in location estimates. In other 
words, relative locations are tracked because the motion re¬ 
moves certain ambiguity from the locations. However, absolute 
tracking without any ambiguity requires at least one anchor. 
This is illustrated in Fig. 10 for a network of M = 4 agents 
and no anchor. 




Fig. 10. Steady state error for a network of 4 mobile agents and no anchor; 
(Left) 2-norm (Right) Red and blue curves represent the exact and estimated 
values of x coordinate, for the last 100 iterations of a simulation. 


B. Localization with noise 

To examine the effects of noise on the proposed localization 
algorithm, we let the noise on the motion of agent i £ 0 
at time k, n l k to be ±1% of the magnitude of the motion 
vector, xj., and the noise on distance measurements, r k to 
be ±10% of the actual distance between nodes i and j, (S'? . 
As shown in Fig. 11 (Left) this amount of noise leads to 
an unbounded error, which is due to incorrect inclusion test 
results and the continuous location drifts because of the 
noise on the distance measurements and the noise on motion, 
respectively. However, by modifying the algorithm according 
to Section |VI| it can be seen in Fig. 11 (Right) that the 


Fig. 11. Effect of noise on the convergence of a network of 10 mobile agents 
and 1 mobile anchor with ±10% noise on distance measurements and ±1% 
noise on the motion; (Left) Original algorithm (Right) Modified algorithm. 


Finally, in Fig. [12] we provide 20 Monte Carlo simulations for 
a network of M = 1 mobile anchor and N = 10 and N = 20 
mobile agents in presence of noise. 



Fig. 12. 20 Monte Carlo trials; ±10% noise on distance measurements, ±1% 
noise on the motion; (Left) N = 10, M = 1 (Right) N = 20, M = 1. 


C. Performance evaluation 

We now evaluate the performance of our algorithm in con¬ 
trast with some well-known localization methods; MCL (8j, 
MSL* (TO), Dual MCL (IT), and Range-based SMCL |<)|. 
Please refer back to Section [I] for a brief description of these 
methods. In Fig. 13 we compare the localization error in the 
Virtual Convex Hull (VCH) algorithm with MCL, MSL*, and 
Range-based SMC. As shown in Table [I] in these algorithms 
node density, rid , and anchor (seed) density, n s , denote as the 
average number of nodes and anchors in the neighborhood of 
an agent, respectively. Total number of agents and anchors can 
therefore be determined by knowing these densities as well 
as the area of the region. We consider N = 20 agents and 
M = 2 anchors, and use the same metric as used in (8)-jl0), 
i.e., the location error as a percentage of the communication 
range. Each data point in Fig. 13 is computed by averaging 
the results of 20 simulation experiments. We keep the other 
parameters the same as described earlier in this section. With 
high measurement noise, i.e., in the presence of 10% noise 
on the range measurements and 1% noise on the motion, 
our algorithm outperforms MCL, MSL* and Range-based 
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Fig. 13. Accuracy comparison 

SMCL after 20 iterations. Clearly, the localization error in 
our algorithm decreases as the amount of noise decreases, and 
our algorithm converges to the exact agent locations in the 
absence of noise. Table [I] summarizes the performance of the 
proposed VCH algorithm in comparison to the above methods. 


Localization 

algorithm 

Simulation environment, 
Network size, 
Communication range 

Average 

error 

%r 

MCL 

500*500, n d =10, n =1, r =50 

0.2 - 0.6 

Dual MCL 

250*250, n d =10, n=2,r=25 

0.4 - 0.6 

MSL* 

500*500, n d =10, n =2, r =100 

0.1 -0.5 

Range-based SMCL 

1*1, n d =13.9, n =1.3, r =0.125 

0.2 - 0.4 

Proposed VCH 

20*20, N=20, M=2, r=2 

<0.1 


TABLE I 

Comparative performance of localization algorithms 


VIII. Conclusions 

In this paper, we provide a distributed algorithm to localize 
a network of mobile agents moving in a bounded region of 
interest. Assuming that each agent knows a noisy version of 
its motion and the distances to the nodes in its communication 
radius, we provide a geometric framework, which allows an 
agent to keep track of the distances to any previously visited 
nodes, and find the distance between a neighbor and any virtual 
location where it has exchanged information with other nodes 
in the past. Since agents are mobile, they may not be able to 
find neighbors to perform distributed updates at any time. To 
avoid this issue, we introduce the notion of a virtual convex 
hull, which forms the basis of a range-based localization 
algorithm in mobile networks. We abstract the algorithm as 
an LTV system with (sub-) stochastic matrices, and show that 
it converges to the true locations of agents under some mild 
regularity conditions on update weights. We further show that 
exactly one anchor suffices to localize an arbitrary number 
of mobile agents when each agent is able to find appropriate 
(virtual) convex hulls. We evaluate the performance of the 


algorithm in presence of noise and provide modifications to 
the proposed algorithm to address noise on motion and on 
distance measurements. 

Appendix A 
Table of parameters 

Table [II] summarizes the important notation. 

Appendix B 
Proof of Lemma 1 

Proof. Consider the triangle, whose vertices are at x”, x” +1 
and x k *. To find the current distance of agent i, from the 
position of agent j at time kj , we can use the law of 
cosines, which connects the length of an unknown side of a 
triangle to the lengths of the two other sides and the angle 
opposite to the unknown side. This triangle is depicted in 
Fig. 2 (c), in which the two known side lengths are d' k 
and % ^ k +1 . Thus, knowing the angle between these sides 
of the triangle, a k .^. k+1 , the length of the third side can be 
determined according to the following 

(^. +1 ) 2 = (5) 2 + (4^ +1 ) 2 (33) 

- 2d%.di.^ k . +1 cos{ai.), 

which corresponds to Eq. & and completes the proof. □ 

Appendix C 
Proof of Lemma 2 

Proof We illustrate this procedure in Fig. [3] where all 
known/measured distances and angles are distinguished from 
the unknowns by bold lines and bold arcs, respectively. After 
agent i makes contact and exchange information with node j 
at time kj, it moves the distance of d k .^ k . +1 to the new 
location, x^ +1 . At this point, agent i can (use the law 
of cosines to) find d k +1 as a function of d k ., d l k .^ k . +1 , 
and , which are all known to this agent, i.e., d k +1 = 

Knowing djj +1 , agent i can then 

find (/>i = g{d^.,di.^. k . +1 ,d^. +1 ). Note that given the three 
sides of a triangle, each angle can be computed. Since agent i 
cannot find any neighbor at time kj + 1, we have /3 k . , 1 = 27r. 
Agent i then changes its direction by a k hl and travels the dis¬ 
tance of d\. +1 ^ kt to the new location, x^*, where he = kj+ 2. 
At this point, agent i can find = /(4'+i> ( 4,-+ 
note that = tr — a k +1 + fi- Agent i can then find </> 3 = 

g{dt k , d\ +1 ^ k(1 d k , + i) at time k(. Since agent i finds node £ 
within the communication radius at time ki, it changes its 
direction by /3^in order to make a contact with agent £. Fi¬ 
nally, knowing d%, d and, = ^(d£,dj£) = 
agent i can find the distance between x k * and x k * according 
to Eq. ( p~0[ ). 3 P 
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Variable 

Description 

Variable 

Description 

Variable 

Description 

Variable 

Description 

Variable 

Description 

0 

Set of all nodes in the 
network 

4 

Measured (noisy) motion 
vector at time k 

0i(fc) 

Triangulation set for agent 
i at time k 

Vdk) 

Set of nodes agent i has 
communicated with until 
time k 

a k 

Self-weight at 

thnek 

Cl 

Set of mobile agents with 
unknown locations 

4 * 

Noise on motion vector at time 
k 

r 

Communication radius 

C(.) 

Convex hull of a set 

a 

Minimum anchor 
contribution 

K 

Set of (mobile) anchors with 
known locations 

4 ; 

True distance between nodes i 
and j at time k 

d i * 

u k^k+ 1 

Distance traveled by agent 
i between times k and k+1 


State (agent coordinates) 
vector at time k 

M t 

t-th slice 

4 

Location estimate of agent i 
at time k 

d l ‘ 

Measured (noisy) distance 
between nodes i and j at time k 

ni ™ 

U k^k+ 1 

Angle traveled by agent i 
between times k and k+1 

u k 

Input (anchor coordinates) 
vector at time k 

ex 

Error at time k 

4 

True location of agent i at 
time k 

★ 

r lJ 

'k 

Noise on measured distance 
between nodes i and j at time k 

Pk-tk+l 

Rotation angle by agent i 
between times k and k+1 to 
find a neighbor 

P k 

Matrix of (Barycentric) 
weights assigned to agents 
at time k 

a' 

Minimum agent 
contribution 

4 

True motion vector at time k 

4 

Barycentric coordinate of node 
j with respect to node i 

★ 

4-*+i 

Rotation angle by agent i 
between times k and k+1 
after communication 

B k 

Matrix of (Barycentric) 
weights assigned to anchors 
at time k 

E k 

Inclusion test 

relative error 


TABLE II 

Parameters and descriptions; random parameters are distinguished by *. 



Fig. 14. Existence of a virtual convex hull; Agent i can perform an update 
if it lies inside the blue triangle at any time k > ks. 


Appendix D 
Proof of Lemma 3 

Proof. Consider a network of 4 agents, {i,j, to, Z}, and let us 
focus on finding a triangulation set for agent i. Suppose all 
agents are moving in an n by n region, and the communication 
radius for each agent is r. In order for agent i to communicate 
with another agent, say j , at time k \, agent j has to lie inside 
a circle with radius r centered at agent i’s location, xj£, 


see Fig. 14 The probability of such event at time k\, is 
therefore given by P (j G V,;(/ci)) = Similarly, the 

probability that agent i communicates with agent to at a later 
time, k 2 > fci, and with agent Z, at time fc 3 > k 2 > k\ can 
be given by P(m G Vi(fc 2 )) = ^ and P(Z G V;(fc 3 )) = 
respectively. Note that the probability of agent to being exactly 
at x|' at time k 2 is zero, and therefore we can draw a virtual 


line (the dotted line in Fig. 141 between the locations at 
which agent i has communicated with agents j and to, i.e., 
between x^,* and x^*. Similarly the probability of agent Z 
lying on the aforementioned line at time fc 3 is zero. Thus, 
the locations where agent (can meet the other three agents at 
different times with nonzero probability, form a virtual convex 
hull. Therefore, the three agents j, m and Z can pass the 
inclusion test for agent i at any given time k > k 3 , if agent i 


lies inside the corresponding virtual triangle. The probability 
of such event at any given time, k > fc 3 , is given by 


(iG^.x^.x^)) = 


area(A(x J fci ,x™%x** 3 ) 


n* 


which corresponds to a non-zero probability for agent i to find 
a triangulation set. □ 


Appendix E 
Pseudocode 


Algorithm 1 Localize N agents in R 2 in the presence of M 
anchors with precision p 

Require: M > 1 and N + M >4 

k <- 0 

xo 4— random initial coordinates 
for i = 1 to N do 

Vi(0) =0 

end for 

while k < termination criteriorf] do 
k 4- k + 1 
for % = 1 to N do 

Vi(k) 4— nodes in the communication radius of agent i 
at time k 

if 0 < |V,;(fc)| < 3 then 

do not update 
else 

perform inclusion test on (all possible combinations 
of) 3 neighbors 

if no triangulation set found then 
do not update 
else 

update location according to Eq. CD 

end if 
end if 
end for 
end while 


8 This expression assumes that agents are uniformly distributed over the 
region at any given time. This assumption can be justified by considering 
random initial deployment and motion. However, the proof follows as long 
as there is a nonzero probability for each agent to communicate with other 
agent(s) in the network. 


9 The termination criterion can be designed according to the number 
of iterations typically needed given the size, mobility, models, and noise 
parameters, as evident from the simulation figures in Section |VII| 
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Appendix F [15] 

Convex hull inclusion test 


In ]R 2 , a convex 

hull inclusion test is as follows 




if X] -^e<(fc)u{i}\3 = 

(34) 

[16] 


j£Si(i) 



i i C(Qi(k)), 

if X ^Bi(fc)u{i}\j > A e .( k ), 

(35) 

[17] 


jeOi(fc) 


in which “\” denotes the set difference, C(-) is the convex 

[19] 

[ 20 ] 




Fig. 15. R 2 : (Left) Robot i lies inside the triangle formed by the neighboring 
nodes, 1, 2 and 3 (Right) Inclusion test is not passed. 


hull, and Aq./^) represents the area of C(0i(fc)), see Fig. 15 


and can be computed by using the Cayley-Menger determi¬ 
nant, 1381. Thus, A.0 i (fc) U {i}v/ is the area of the set Qi(k ) 
with node i added and node j removed. 
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